function distance = CalcDistance(node1, node2 )
    [X,Y,Z] = textread('data5x5x5.txt', '%f%f%f');
    distance = sqrt ((X(node1)-X(node2))^2 + (Y(node1) - Y(node2))^2);
end